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1 Introduction 

The aim of this work is to describe in an intrinsic way higher-order Euler-Lagrange equations 
on trivial principal bundles. The main motivation is the analysis of a class of optimal control 
problems that are important in a wide range of contexts, such as the search of less cost devices in 
industrial processes, aerospace and defense, marine and automotive systems, electro-mechanical 
systems and robotics, among others. The problem consists in finding a trajectory of the state 
variables and control inputs, solution of the controlled Euler-Lagrange equations given initial 
and final conditions, and minimizing a cost function. 

The study of higher-order tangent bundles has been developed in the last decades for different 
reasons, as a training field to understand field theory, theoretical physics, relativistic mechanics, 
classification of higher-order symmetries, among others [H HOl [Ml [201 1211 EZl [Ml IHEl HI]. In 
the last decade, higher-order variational problems had an extraordinary impact in the design 
and planning of trajectories, interpolation problems in Riemannian manifolds, optimization 
problems, optimal control applications, higher-order jet groups and particle methods, image 
registration methods for computational anatomy, etc. [71 [l3l |24l [25l IHH |32l [Ml 133 

In 1983, R. Skinner and R. Rusk introduced a formulation for the dynamics of an autonomous 
mechanical system which combines the Lagrangian and Hamiltonian features |43j . The aim of 
this formulation is to obtain a common framework for both regular and singular dynamics, ob- 
taining simultaneously the Lagrangian and Hamiltonian formulations of the dynamics. Over the 
years, the Skinner-Rusk framework, or unified framework, has been extended in many directions: 
explicit time-dependent systems using a jet bundle language OUB], vakonomic mechanics and 
the comparison between the solutions of vakonomic and nonholonomic mechanics [15], higher- 
order dynamical systems [391 140] , first-order and higher-order classical field theories [H [23l |44] , 
and optimal control applications [21 [H [12] . 

Our main objective in this paper is to characterize geometrically the equations of motion for 
a higher-order autonomous system with constraints using an extension of the Skinner-Rusk for- 
malism for higher-order trivial principal bundles, and apply this to the optimal control problem 
of an underactuated mechanical system. Underactuated mechanical systems are characterized 
by the fact that there are more degrees of freedom than actuators. This type of systems is 
quite different from a mathematical and engineering perspective than fully actuated control sys- 
tems (that is, where all the degrees of freedom are actuated). Underactuated systems include 
spacecraft, underwater vehicles, mobile robots, helicopters, wheeled vehicles, mobile robots, un- 
deractuated manipulators... The main results of this work can be found in Section 3, where 
we give a general method to deal with explicit and implicit, constrained and unconstrained 
mechanical systems. 

The organization of the paper is as follows. In Section [2] we introduce some geometric 
constructions which are used along the paper. In particular, the Skinner-Rusk formalism for 
first-order mechanical systems, the Gotay-Nester-Hinds algorithm, some geometric aspects of 
higher-order tangent bundles, and Hamilton equations for a Hamiltonian system defined on 
the cotangent bundle of a higher-order trivial principal bundle. In Section [3] we introduce 
the Pontryagin bundle T*(T'^~-^M) x G x A;g x kg*, where we introduce the dynamics using a 
presymplectic Hamiltonian formalism, and we deduce the A;th-order Euler-Lagrange equations 
in this context. Since the system is presymplectic, it is necessary to analyze the consistency of 
the dynamics using a constraint algorithm. We show that our techniques are easily adapted to 
the case of constrained dynamics. As an illustration of the applicability of our formulation, we 
analyze in Section[5|the case of underactuated control of mechanical systems and, as a particular 
example, the optimal control problem of an underactuated vehicle in SE{2) x S^. 
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All the manifolds are real, second countable and C°°. The maps and the structures are 
assumed to be C°°. Sum over repeated indices is understood. 

2 Mathematical background 

In this section we give the notation used along this work, and the basic mathematical background 
needed about higher-order tangent bundles. There is also a sketch of the Gotay-Nester-Hinds al- 
gorithm and the Skinner- Rusk formalism for first-order systems. Finally we will derive Hamilton 
equations for higher-order trivial principal bundles. 

2.1 The Lagrangian-Hamiltonian unified formafism 

(See [43] for details.) 

Let Q be a n-dimensional smooth manifold modeling the configuration space of a first-order 
dynamical system with n degrees of freedom, and C € C°°(TQ) a Lagrangian function describing 
the dynamics of the system. 

Let us consider the bundle 

W = TQxqT*Q. 

This bundle is endowed with canonical projections over each factor, namely pr^^ : W — ?> TQ and 
pr2 : W -^ T*Q. Using these projections, and the canonical projections of the tangent and 
cotangent bundle of Q, we introduce the following diagram 

TQxqT*Q 




Local coordinates in W are constructed as follows: if (f/, 93) is a local chart of Q with 
^ = {1^)1 1 ^ A ^ n, then the induced local charts in TQ and T*Q are {TQ^{U),{q^,v^)) 
and (ttq {U),{q ,pa)), respectively. Therefore, the natural coordinates in W are {q ,v ,pa)- 
Observe that dimW = 3n. Using these coordinates, the above projections have the following 
local expressions 

pri(g^,t;^,PA) = iq^,v^) ; pr2(/,f^,PA) = (/,Pa) • 

The bundle W is endowed with some canonical geometric structures. First, let 9 € f2^(T*Q) 
be the Liouville 1-form on the cotangent bundle and uj = —d9 G i7^(T*Q) the canonical sym- 
plectic form on T*Q. From this we can define a 2- form fi in W as 

n:=pr*2UJen^{W). 

It is clear that is a closed 2-form, since 

n = p4{-d9) = -dpv*2e . 
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Nevertheless, this form is degenerate, and therefore is a presymplectic form. This is easy to 
check in coordinates. Bearing in mind the local expression of the canonical symplectic form of 
the cotangent bundle, which is w = dq A dpA, and the local expression of the projection pr2 
given above, we have 

n = prlidq^ A dpA) = pr^(dg^) A pr^(dpA) = dpr^(g^) Adp^iPA) = dq^ A dp a ■ 

From this local expression, it is clear that the kernel of 17 is given locally by, 

where X^^^^'{W) denotes the module of vector fields of W which are vertical with respect to 
the projection pr2 (that is, X^^^'^^'iyV) = ker(Tpr2)). Therefore the 2-form Q is degenerate. 

Definition 1 Let p ^ Q be a point, Vp G TpQ a tangent vector at p, and ap G T*Q a covector 
on p. Then we define the coupling function C € C°°(yV) as 

C:W — > R 
{p,Vp,ap) I — y {ap,Vp) 

where {ap,Vp) = ap{vp) is the canonical pairing between elements of TpQ and TpQ. 

d 



If we consider a local chart onp ^ Q such that ap = p^dg ,Vp = v 



A\ „, _ „A 



.p - yA^^ ip, up- u ^^^ 

expression of C is 



, then the local 
p 



C{p,Vp,ap) = {ap,Vp) = ( PAdq^\„, v^ 



-p,"p; - \"p, -p/ - \ fA--H I , - o A 



dq^ 



) = VAv\ 



Finally, we define the Hamiltonian function K G C°°(VV) by 

^ = C - pr;^ £ , 

whose local expression is 

H{q'',v^,PA)=PAV^-ll{q^.v^). 

Hence, we have constructed a presymplectic Hamiltonian system (W, 0,^^). The dynamics 
for this systems is given by equation 

i{X)Vt = dH, 

where X G 3C(W) is the Hamiltonian vector field of the system. 

2.2 The constraint algorithm 

In this subsection we briefly review the constraint algorithm for presymplectic systems. (See 
[271 [281 [29] for details). 

By definition, if (Mi , fi) is a symplectic manifold then the equation 

i{X)VL = a (1) 
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has a unique solution X £ X(Mi) for every a € f2^{Mi) that we consider. Nevertheless, if il is 
closed and degenerate (that is, presyniplectic), then the above equation may not have a solution 
defined on the whole manifold Mi, but only in some points of Mi. The tuple {Mi,Q,a) is 
said to be a presymplectic system. The aim of the Gotay-N ester-Hinds algorithm, or constraint 
algorithm, is to find a final submanifold Mf ^-> Mi such that the equation ([T|) has solutions in 
Mf (if such submanifold exists). More precisely, the constraint algorithm returns the maximal 
submanifold Mf of Mi such that there exists a vector field X € X{Mf) satisfying equation ([T]) 
with support on Mf. 

The algorithm proceeds as follows. Since il is degenerate, then equation ([T]) has no solution 
in general, or the solutions are not defined everywhere. In the most favorable case, equation 
([T]) admits a global (but not necessarily unique) solution X € X{Mi). Otherwise, we select the 
subset of points of Mi, where such a solution exists, that is, 

-^2 := {p G Ml : there exists Xp G TpMi satisfying i(Xp)i7p = Up] 
= {p G Ml : {i{Y)a){p) = for every Y G ker 0} , 

and we assume that it is a submanifold of Mi. Then, equation ([1]) admits a solution X defined 
at all points of M2, but X is not necessarily tangent to M2, and thus it does not necessarily 
induce a dynamics on M2. So we impose a tangency condition along M2, and we obtain a new 
submanifold 

-^3 '■= {p ^ -^2 : there exists Xp £ TpM2 satisfying i{Xp)Qp = Op} . 

A solution X to equation ([1]) does exist in M3 but, again, such an X is not necessarily tangent 
to M3, and this condition must be required. Following this process, we obtain a sequence of 
submanifolds 

■■■Mi^ ■■■ ^ M2^ Ml 

where the general description of M;_|_i is 

M;+i := {p £ Mi: there exists Xp £ TpMi satisfying i{Xp)Qp = Up} . 

If the algorithm terminates at a nonempty set, in the sense that at some s ^ 1 we have 
M;_|_i = Ml for every / ^ s, then we say that Mg is the final constraint submanifold which is 
denoted by Mf. It may still happen that dim. Mf = 0, that is, Mf is a discrete set of points, and 
in this case the system does not admit a proper dynamics. But in the case when dim. Mf > 0, 
by construction, there exists a well-defined solution X of equation ([T]) along Mf. 

2.3 Higher-order tangent bundles 

In this subsection we recall some basic facts of the higher-order tangent bundle theory. We 
particularize our construction to the case when the configuration space is a Lie group G. (See 
[elllSlil] for details.) 

Let Q be a n-dimensional smooth manifold, and k £ N. The kth order tangent bundle of 
Q, denoted by T Q, is the {k -\- l)n-dimensional smooth manifold made of the A;-jets of curves 
0: M ^ Q with source at G M; that is, T'^Q = J^{R,Q). It is a submanifold of J''{R,Q). A 
point in T^Q is denoted j'q </>, where (/> is a representative of the equivalence class. 

We have the following natural projections: ii r ^ k, 

p^ : T^Q — > T'Q (3'' : T^Q — > Q 

joV ^ fo<P ' JoV ^ HO) ■ 
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Observe that pg = f3^, where T^Q is canonicahy identified with Q, pf. o p^ = p^ for every 
r ^ s ^ k, and p^ = Idr^kg. 

From a local chart ([/, 99) of Q, where ip = {(f ), 1 ^ A ^ n, the induced local coordinates in 
T^Q are constructed as follows: let 0: M — )■ Q be a curve such that 0(0) € U. Then, denoting 
0^ = ip^ o (/), the point Jq0 is given in {(3'')^^{U) as (^q , . . . , q^) = (qf), ^ i ^ k, where 



4 = <P» , '^ ^^"^^ 



When there is no risk of confusion, we use the standard conventions, ^q = q , qf = q and 
Q2 ~ 9 ■ Using these coordinates, the local expression of the canonical projections are 

Now, assume that Q = G is a finite dimensional Lie group, and let us consider the left- 
multiplication on itself 

GxG ^ G 

{g,h) I — > gh 

If we denote £g{h) = gh for every g,h G G the left-translation, it is obvious that £g: G —^ G is 
a diffeomorphism for every g ^ G. 

Remark: The same is valid for the right-translation, but in the sequel we only work with the 
left-translation, for the sake of simplicity. 

The left-translation enables us to trivialize the tangent and cotangent bundles of G as follows 

TG ^ Gxg T*G -^ G x g* 

{9,9) I — > {9,0 = (.9,9^^9) = {9, T'g^g-ig) ' {9,(^9) I — > {9,01) = {g,Tl£g{ag)) ' 

where g = TgG is the Lie algebra of G and e € G is the neutral element of the group. 



For higher-order tangent bundles, we can also use the left-translation to identify the fcth- 
order tangent bundle of G, T G, with G x /eg as follows: if^c/CR^Gisa curve, we 
define 

T'=:T'=G — > GxkQ 

Jo^ ^ (^(0), 5-1(0)5(0), ^1,^0 (5-i(t)ff(t)),...,J^[^^(5-nt)5(t))) • 

It is clear that T'^ is a diffeomorphism. If we denote by ^(t) = g''^{t)g{t), we can rewrite the 
above expression as 

T\j^g) = {g,e,e,...,e''), 

where 

(s"'(t)s(t)), omk--i. 



s = m ; e = ^ 



t=o "'' 



t=o 
We will indistinctly use the notation S,^ = (,, S,^ = C, where there is no danger of confusion. 

In this case, the canonical projections p^ and /3^ are denoted by 

T,^ : T'^G — > T'^G _ r^ : T'^G -^ G 
Jo9 I — > 3o9 ' Jo9 I — > 5(0) 

Using the previous identifications, we have 

r^i9,e,---,e-') = i9,e,...,e~') ■, 4i9,e,---,e-') = 9- 

As before, t^ o Tg = rj: , Tq = Tq, and r| = Idc- 
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2.4 Higher-order Hamilton equations in M x G 

Let us consider the manifold Q = M x G, where M is a Tn-dimensional smooth manifold and G 
is a finite dimensional Lie group. Using the results of Section [2.3^ we have 

T*(T^"^Q) = T*(T^-^(M X G)) ~ T*(T^-^M) x G x (A; - 1)0 x kg* . 

In order to geometrically derive Hamilton equations for higher-order variational problems 
we need to equip the previous space with a symplectic structure. Thus, we construct a Liouville 
1-form 9 and a canonical symplectic 2-form u by pull-backing the canonical Liouville forms in 
T*{T''-^M) and G x (A; - 1)0 x ^0. Let {qf,p\) be the natural coordinates in T*{T^-^M), and 
denote by ^ € {k — l)g and a e kg* with components $ = {S,^, ■ ■ ■ ,^^^'^) and ex = (ao, • • • ,qa;-i). 
Then, after a straightforward computation, we deduce that 

fc-1 
j=0 

where ^^ G kg and i/° G A:0*, a = 1, 2 with components ^^ = (^^) and i^" = (f ?), ^ z ^ /c — 1, 
where each component ^* € and v^ € 0*. Observe that ao comes from the identification 
T*G~Gx0*. 

Given a Hamiltonian function H G C°°(T*(T''~^(M x G))), we compute 

/ (9ff \ ''^"^ / f)H 



^ ' i=0 ^ ^ 

Now we can derive Hamilton equations for a higher-order dynamical system in a trivial 
principal bundle. First, let us compute the Hamiltonian vector field Xh G X(T*(T M) x 
G X (k — 1)0 X kg) satisfying the geometric equation i{XH)i^ = dH. If Xh is locally given by 
^H{<li,p\, 9, ^, Q:) = {F^, G\, ^i, u^), then the previous equation gives the following system of 
equations 

F^^ = J^T('if^PA,9,$,(^), 
dp\ 

~ BT-f 

G\ = -jrAilf^P^A,9,i,a), 
dqf 

oH , A j J. \ 

4l = -g^i^i ^Pa, 9,^,0^), 



f, 



1 _ p*^^ f„A J, 




°^9 7i~(^i ^P\^9,^,OL)+ad*^oaQ, 



dg 
dH 



'}+i = —g^{qf,p%g,^,a), O^i^k-2. 
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Finally, if 7(t) = (9j^(0,P^(i)) 5(0) ^(0> ^(0) is an integral curve oi Xh, then from the condition 
Xh o 7 = 7 we obtain the higher-order Hamilton equations 

f)J-f 

Qf = -gTiQf^PA,9,^,c^), O^i^k-1, 

r)J-f 

dqf 

oH , A j J. \ 
9 = 9^ — {Qi ,Pa,9,^,(^), 

fiJ-f 

e = -Q^^qf,PA,9,^,a), l^i^k-1, 

f)J-f 

ao = -£*g^{qf,PA^9,^,a) + ad*Qfj/Oao^o, 

ai+i = -^{qt,PA,g,i,OL), Oi^ii^k-2. 

3 Geometric formalism for higher-order variational problems 

In this section, we describe the main results of the paper. First, we intrinsically derive the 
equations of motion for Lagrangian systems defined on higher-order trivial principal bundles 
and, finally, we extend the results to the case of variationally constrained problems. 



3.1 Unconstrained problem 

3.1.1 Geometrical setting 

Let Q be a finite dimensional smooth manifold modeling the configuration space of a /cth-order 
dynamical system, and let £ G C°°{T''Q) be a Lagrangian function describing the dynamics of 
the system. Consider the Pontryagin bundle W = T Q Xr^k-in T*(T Q) in a similar way as 
in [39]. Now, if we take Q = M x G, where M is a m-dimensional smooth manifold and G is a 
finite dimensional Lie group, we have 

W = T''{M X G) XTfe-i(MxG) T*(T'=-1(M X G)) 

~ (T'^M XTfe-iM T*(T'=^1m)) X (T'^G x^fc-iG T*(T'=-1G)) = Wm x Wg 

where we denote Wm ■= T'^M Xt^-ia/ T*(T'=-iAf) and Wg ■= T^G Xt^-ig T*iT^'^G). Using 
left-trivialization and the results in Section 12.31 we have the following identifications 

T''G ~ G X yfcg; T*{T^-^G) ~ G x (A: - l)g x kg*, 

and therefore the manifold Wg admits the identification 

Wg ^ G X kQ X kg*. 
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Taking into account all the previous comments, we can consider the diagram illustrating the 
situation 



Wm 



Pri 




T^M 



T*(T'=-iM) 



G X kg 



G X (fc — l)g X kg* 



Pk-i 



rpfc-l^J 



Gx {k-l)i 



where all the maps are the canonical projections. 



Let {qi,q'^,p\), where ^ i ^ k — 1 and 1 ^ ^4 ^ m, be a set of local coordinates 



m 



Wm (see [39] for details), and {g,$,C'''\a), where $ = (f , . . . , C'"'^) £ {k - l)g and a = 
(aO) • • • ) Ofc-i) £ ^0*! a set of local coordinates in Wg (see [12] for details). Then, the induced 
natural coordinates in W = Wm x VVg are {qf , q^ jPa^ S^ ^j ^''~^ ^ ol) ■ Using these coordinates, 
the above projections have the following local expressions 



V^l{qf,qtPA,S,^,^^'\oL) = {qf,qtPA) 

wiiqf,qk,PA) = iQf,Qk) 



pr^{qt,q^,p\,g,$,,£!'-\cx) = {g,^,^''-\a) 
W2iQf,QtPA) = i<lf,PA) 



The bundle W is endowed with some canonical geometric structures. First, let ujk-i € 
J7^(T*(T''"^M)) and a;G'x(fc-i)g ^ ^^(G x {k - l)g x kg*) be the canonical symplectic forms 
in T*(T'^~^M) and T*(T^~^G) ~ G x (A: — 1)0 x kg*, respectively. Then, we can consider the 
presymplectic forms Qm = W2^k-i S ^^(Wm) and Q,g = W2^Gx{k-i)e ^ ^^(Wg)- Then we 
define the following presymplectic form in W 

^ = pri nM + p4 f^G e n^ [w] . (2) 

Observe that since ker J^a/ = X^^p'^\Wm) and ker J^g = ^^^'^^\Wg), we have 

ker J^ = X^(P''2opri)(y^;) p X^^p'^\W) + X^^'p'^°p'^\W) D X^^p'^\W) . 
In natural coordinates, recall that the forms cok-i and <^Gx(fc-i)g are locally given by 

fc-i 
(wfc-i)(gA pi^) (^(Fj ,G^),(Fj ,G\)j =2_^yFi G\-Fi G\j 

{^GAk-l)X,i,c.) {{iiy). {^2, ^')) = (^', ^l) - (^\ ^2) + («0, [fl, ^2]) 

k-1 

j=0 

where ^„ = (e2,•••,e^') G ^0, ^'^ = {^S , ■ ■ ■ , J^^.,) G A^g* (a = 1,2), {qf,p\) G T*(T'^-1M) 
and {F^^,G\),{F^^,G\) G T(gA_p,^)T*(T'=~iM). Therefore, the presymplectic form n G J72(W) 
is locally given by 

fc-i 
%f,,tP\,94,e-\o.) iXi,X2) = Y, {i'^^G\ - FtG\ + (1/2,^^) _ (^1,^^)) + i^ao, [iUl]) , (3) 

i=0 
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where Xi = {F^^ , F^ , G% i^, il y) , X2 = {F/^,F^,G\,$2,^l''^) ^ ^W- Moreover, a local 
basis for kerfi is 

The second relevant canonical structure in W is the coupling function C G C°°(W). First, 
since T^M is canonically embedded into T{T^~^M), we can define a canonical pairing between 
the elements of T*(T M) and the elements of T M as a function in C^^OVm)- Indeed, let 
p G T'^M be a point, g = p^_i{p) its projection to T'^^^M and a^ G T*(T'^'^^M) a covector. 
Then, the function Cm ^ C°°(yVM) is defined as 

(P,a<?) ' — > {aq,jk{p)q)k-i ' 

where jk '■ T^M ^-s- T(T^^^M) is the canonical embedding, jk{p)q G Tg(T'^^-'^M) the correspond- 
ing tangent vector to T^^^M in q, and (• , ■)k-i: T(T''"1M) x T*(T^"1M) -^ R the canoni- 
cal pairing. In natural coordinates, if p = {qQ,...,q^), then q = p^_i{p) = {qQ,...,q^_i), 
and the canonical embedding is locally given by jk{p) = {Qq, ■ ■ ■ jQk-i^li^ ■ • • ^Ik)- Hence, if 
d 

\q ^ "9 



G Tq{T^-^M) and Og = p^ dqf\ G T*(T''~1M), then the local expression 



3k{p)q = qt+i Q^ 

of the function Cm is 

CM{qf,qt,PA) = PAlf+ilg ■ 

On the other hand, we can define a canonical pairing in Wg — G x fcg x fcg* as a function 
Cg G C°^(Wg) as follows 

Cg : G X fcg X fcg* — > M 

Bearing in mind the above constructions, we can give the following definition. 

Definition 2 The coupling function C G C°°(W) is defined as 

C = pr* Cm + pr2 ^G • (5) 

In the induced natural coordinates of W, bearing in mind the local expressions of both Cm 
and Cg, and the coordinate expressions of the projections pr^ and pr2, we have that the coupling 
function C G C°^(W) is locally given by 

C{qf,qtPA,9,^,^'''\<^) = Y. {PAqt+l + («*>?')) • 

i=0 

Now, given a Lagrangian function C G C°°(T (M x G)), we can define the Hamiltonian 
function H G C°^(W) as 

H = C-TT*C, (6) 

where vr: W — )■ T (M x G) is the natural projection, and whose local expression is 

fc-i 

H{qf, qtPA, 9, ^, C'''\ ") = J^ {paqAi + («*, O) " ^qf, qt 9, ^, ^'''^) ■ 

i=0 
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3.1.2 Dynamical equation 

The dynamical equation for a presymplectic Hamiltonian system (W, Q, H) is geometrically 
written as 

i{X)n = dH , for X € X{W) . (7) 

Then, following [29], we have 



Proposition 1 A solution X € 3C(W) to equation ^ exists only on the points of the subman- 



]c 



ifold Wc'^W defined by 

Wc = {pe W: {i{Y)dH){p) = 0, Vy € kerf]} 



In natural coordinates, since dH G f2^{W) is locally given by 

dC ~ ( ■ dC \ 



(8) 



where Y = {FC,F^,G% $,2,^1,1''^) G X(W), and kerJ] has local basis ©, we have 



i{Y)dH = < 



fc-i 
Pa 



Oik-l 



dC 



if y 



d 






Therefore, Wc ^-> W is locally defined by the constraints 



Pa 



k-l 



dC 
dQk 



; ak- 



dC 



di- 



k-l 



Now, let us compute the local expression of equation d?]). Let X G X(W) be a generic vector 
field locally given by 



X = F, 



d_ 

« ^Za 



d<li 



+ F, 



d 



d 



d 






, +^^^+^^^+^^"V + ^^^a^ = (^ '^-^-^-^--)- ^'^ 



Then, using ^ and dH), we have the following system of equations 



dqo 



Pa 



k-l 






+ a(i*oao , f/+i 



"fc-i 



Ft = 


Qti, 


dC 

dqf 


Pa\ 


dC 


= 0, 


Ci 


= e, 


dC 




oe 


- CX-ii 


d£ 


- n 



di- 



k-l 



(10) 

(11) 

(12) 

(13) 
(14) 

(15) 
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Therefore, the vector field X solution to equation ([7]) is locally given by 



^.+1 QqA + ^k Q^A + Q^A gpO^ + [g^A Pa ) g^^ 

Observe that equations (J12p and (jlSp are compatibility conditions that say that the vector field 
X exists with support on a submanifold defined locally by these equations. Hence, we recover 
in coordinates the result stated in Proposition [TJ 

The coefficients F^ and ^^ are yet to be determined. Nevertheless, recall that X is a vector 
field in W that exists at support on Wc- Hence, we must study the tangency of X along the 
submanifold Wc', that is, we must require L{X)(\y^ = X(C)|yy = for every constraint function 
C defining Wc- Thus, taking into account that Wc is locally defined by equations (|12p and (jlSp . 
the tangency condition for X along Wc gives the following equations 



d^ti ''^~ ''^'dgfag^^'^'dq^dqi 



^e^^.e^^^.e. ''' 



^ dgdq^ d^'^dq^ ' ^'^ d^^~^dq^ 



_d£__ _ B 5^/: o d'^C 

g^k-2 - "fc-2 - li+^dqBQ^k-l + ^fc gqBg^k-l 



(16) 






These equations enable us to determinate the remaining coefficients F^ and £^\ of the vector 
field X. Observe that if the Hessian matrix of C with respect to the highest-order "velocities", 
q-^ and ^^~^, is invertible, that is. 



det 



dq^dq^ dq^de-^ 



(p) / , for every p G T'^M x G x kQ 



\d^k-igqA g^k-ig^k^ij 



then the previous system of equations has a unique solution for F^ and ^f , thus obtaining 
a unique vector field X G X(W) solution to the equation ([7]). In particular, the constraint 
algorithm finishes at the first step. Otherwise, new constraints may arise from equations ()16p . 
and the algorithm continues if necessary. 

Remark: In the particular case when the Hessian matrix of the Lagrangian function is a block 
diagonal matrix, that is, 

and — 2 r = , for every l^A^m,0^i^k,0^j^k — 1, 



dqfdg dq^d^J 

then equations (fTHl) become 



_dC__ ,_,^ B d^(^ B d'C 

dQtl "^^ ''^'dqfdq^^'^dqidqr 



g^k-2 "fe-2 "^ ^aggg^k-i^^ g^ig^k-i ^ ^i g^k-ig^. 
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In this case, to solve the equation d?]) in W is equivalent to solve separately the corresponding 
equations in Wa/ and Wg following the patterns in [39J and [12], respectively, and then take 
X = Xm+Xg as a solution of equation ([7]), where Xm £ ker pr2 is a vector field pr^^-related with 
the vector field solution to the equation in Wm and Xg G ker pr^ is a vector field pr2-related 
with the solution of the equation in Wg- 



Now, let 7 : M —7- W be an integral curve of X locally given by 

lit) = {qf{t),qtit),p\{t),g{t),e{t),aiit)). 



(17) 



From the condition X o 7 = 7 we obtain the following system of differential equations for the 
component functions of 7 



Pa 



dC .,• dC ,_i 



dqf" 



do = -fg-o 1" at^oOLQ 



dq. 

9 = 9^ , e-' 

dC 



OLi+l 



de 



OLi 



(18) 
(19) 

(20) 
(21) 



in addition to equations (J12p and (|15p . Now, using equations (J12p in combination with equations 
(J19l) we obtain the fcth-order Euler-Lagrange equations 



E(-i) 



d' dC 



«=o 



dt^ dqi 



(22) 



On the other hand, using equations (J15p in combination with equations (j2ip we obtain the 
/cth-order trivialized Euler-Lagrange equations 



d_ 
di 



X fe-i 

^diAY^i-i 

^ i=0 



I d dC 
dFd^ 






(23) 



Therefore, a dynamical trajectory 7: 
equations 



W of the system must satisfy the following local 



E(-i) 



d' dC 



i=0 



dP dqi 



dt 






_d_dC 
dt^'d^ 



£* 



dC 
dg 



Remark: The above equations may be compatible or not. If not, a constraint algorithm must 
be used in order to find a final submanifold where the above equations have a solution (if such 
a submanifold exists). 

Finally, if the Lagrangian function C G C°°(T*^M x G x kQ) is left-invariant, that is, 

C[qt^qt9.e) = C[qt^qth,e), 
for all g,h ^ G, then we can define the reduced Lagrangian i G C°°(T^M x kg) by 

l{qf,qte)=Ciqf,qle,e), 
and therefore equations (j23p become the kth order Euler-Poincare equations 



{^r^'Yi^-^y^^ 



0. 



(24) 
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Observe that equations ([2^ remain the same with the reduced Lagrangian function, just replac- 
ing C by £. 

Equations ([22]) and (p3]) are exactly the same that one of the authors derived in [11] us- 
ing variational techniques. Our derivation allows us to identify staightforwardly the geometric 
preservation of the system, for instance, preservation of the Hamiltonian or (pre)symplecticity 
of the flow. 

3.1.3 A theoretical example 

Now, we give a theoretical example inspired by the applications in Clebsch variational principle 
and continuum mechanics studied in [26] [33] . 

Let us consider the particular case when the manifold M is the dual of a real vector space, 
that is, M = V*, where y is a finite dimensional real vector space. In this case we have the 
following identifications 

T'^y* ~ (fc -h i)y* , T*v* c^v* xv 

T*(T'=-V*) ~ k{V* X V) 

Using these identifications, we have 

Wv = T^V* x^fc-iy. T*(T'=^V*) ~ (A: + 1)V* x kV 

Since V and V* have global charts of coordinates defined by any basis, we will denote an element 
of {k + 1)V* by (/x,/ifc) = (/ij,Mfe) = (/io, • • • ,/^fc), where fij E V* for every ^ j ^ fc, and an 
element of kV will be denoted by (v) = {v^, . . . , v ), where v^ G V for every ^ j ^ k — 1. 
Then, an element of Wy* will be denoted (/x, fj-k,"^) = (/^Oi • • • ) f^k-i, fJ-kjV^, ■ ■ ■ , v'^'^). 

The canonical projections pr-j^ : {k + 1)V* x kV ^ {k + 1)V* and pr2 : (A; -|- 1)^* x kV -^ 
kV* X kV are given by 

pri(/^,^fc,v) = (/x,/iA;) ; pr2(/i,^fc,v) = (/x,v). 
Let uJkv* £ (^"^{kiy* X V)) be the canonical symplectic form in kiV* x V), which is given by 

fc-l k-l 



j=0 i=0 



where (•, •)y* is the canonical pairing between the elements of V* and its dual V** ~ V . We 
define the presymplectic form in Wy* as Oy* = pr2i^fcy € i7^(Wy*). This 2- form is given 
locally by 



fc-i 



(^v^')(M,M.,v)((/3^/3i<),(/3f,/3L4)) = E('^'(^2)-/3fK))- 

Now, we define the canonical pairing in 'Wy* — {k + l)V* x kV as a function Cy* E C°°(yVy) 

as follows: 

Cy : {k + l)V* xkV — ^ M 

With these elements, we can follow the patterns in Section [3.11 Let us consider the manifold 
Q = V* X G. Then we consider the Pontryagin bundle 

W ~ (A: + 1)V* xkV xGxkQxkQ* . 
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Then, the diagram in Section [3.11 becomes 




{k + l)V X kV 



{k + l)V* 




kV* X kV 



G X kg X kg* 
Ff 1 ^^^ ^~~"--^ W2 



G X kg 



G X {k - l)g X kg* 



Gx{k~ l)g 



Let (/i,^fc,v) be local coordinates in Wy* and {g,$,^^,oc) are local coordinates in Wg- 
Then, the induced local coordinates in W are (/x,/^^, v, f/,^,^'^, ct). The canonical projections 
pri: {k + l)V* X kV X G X kQX kg* -^ (A: + 1)^* x /cF and pra : {k + l)V* x kV x G x kgx kg* ^ 
G X kg X kg* are given in these coordinates by 

Pi"l(At,/Ufc,v,sr,^,^'',Q;) = (/x,^fc,v) ; pr2(/x,/ifc,v,5r,^,^'',Q;) = {g,^,^'' ,a). 



The presymplectic form $7 € i7^(W) defined in ([2]) is now given by 

ik-l 



n 



(M,M.,v,5,e?-^c.) {Xi,x2) = Y, (/3.H4) - /3f K) + w?,c\) - (^^e^)) + («o, [e?,e2°]) 



where X^ = {fi}, /3l,u\,^^,^'[,i^^),X2 = (/32,/3|,4,^2,?t, '-') ^ X(W). The coupling function 

C G C'^(W) is 

fc-i 

1=0 

Let C G C°°((A; + l)y* x G x kg) be a feth-order Lagrangian function. We define the 
Hamiltonian function H G C°°(W) by 

fc-i 

i=0 



Now, if X G X(W) is a vector field, locally given by 

_d_ 

W ' "' da 

i{X)n = dH, 






d ^ d 

'.^ l-Pfc-^— 



d_ 



d_ 
dg 



then the dynamical equation 
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give rise to the following system of equations 



u 



dC 



,9£ 
dg 



1 p^ oi^ ^ 



n 



Ofc-l 





A = 


IJ'i+i , 


i 


dC 


v'-\ 


k-1 


dC 

duk 


= 0, 




i\ 


= e, 


1 


dC 




''+1 


dC' 


- Oj, 




dC 


-n 



Therefore, the vector field X solution to the dynamical equation is locally given by 

d 



_d_ _d_ dC^_d_ f dC 



..i-l 



dv\ 



+el+( 



rt+l ^ 



dg ' " 5e ' '"dC''-^ 



1 + ^r 



d 






i+l 



Finally, the tangency condition along the submanifold Wc defined locally by the constraints 



,,fc~i 



dC 







d£ 



Oik-l 



0, 



gives the following system of equations for the remaining coefficients /3fc and ^\ 



(25) 



dfik-i 
dC 



k-2 d^ o d'C 



Ofc-2 — /^i+1 



dfiidfik 



d^xidi^ 



— + ^fc 



^^lk^^J'k 



+e°=e:— — +r+i--— +^^ 



' dgd^ik 



d^'-dfj.k 






dfikdC 






d^c 



'dgd^f" 



Q^iQ^k 



Q^k-lQ^k 



If the matrix 



/ d^C 



d-'c \ 



dukdfik dfikdC'"'^ 

is regular for every point p € (A; + \)V* x G x kg, then by a direct computation the previous 
equations have a unique solution for ^k-i and ^f • 



3.2 Constrained problem 

3.2.1 Geometrical setting 

As in Section I3.H let Q be a finite dimensional smooth manifold modeling the configuration 
space of a fcth-order dynamical system. Now we assume that the dynamics of the system are 
constrained. Geometrically, the Lagrangian function containing the dynamical information of 
the system is defined at support on a submanifold of T Q. Let jj\f: J\f ^-t- T Q be the constraint 
submanifold, with codimA/" = n, and jCj\f G C°°(A/') the Lagrangian function describing the 
dynamics of the constrained dynamical system. 
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Let us consider the submanifold W = M x^fc-ig T*{T''-^Q) of T'^Q XTfc-iQT*(T'^-ig) with 
canonical embedding iy^: W ^-> T'^Q Xrp^^iQ T*(T'^~^Q) and natural projection pr_;^^: W — )■ M. 
If we take Q = M xG, where M is a ?Ti--dimensional smooth manifold and G a finite dimensional 
Lie group, then we have W = Af x^fc-ij^,^ T*(T''"^M) x kQ*. 

Now, using the results given in Section [3. 11 we can define a closed 2- form in W as i7 = i^^ G 
^^(W), where Q G i7^(VV) is the presymplectic form defined in ([2]), and a Hamiltonian function 
H = i^C - v^lfC-M e C~(W), where C G C°°(>V) is the couphng function defined in (p. With 
these elements we can state the dynamical equation for the constrained problem, which is 

i{X)Tl = dH. (26) 

Since M M- T (M x G) is an arbitrary n-codimensional submanifold, we do not have a natural 
set of coordinates in W, and therefore the local study of the equation can not be done in a 
general setting. For this reason, we adopt an "extrinsic point of view" , that is, we will work in 
the bundle W, and then require the solutions to lie in the submanifold W "^ W. 

In order to do this, we must construct a Hamiltonian function H G C°°(W) using the 
Lagrangian function C_^ G C°°{J\f) containing the dynamical information of the system. Hence, 
let C G C°°(T (M X G)) be an arbitrary extension of C^^, and let H be the Hamiltonian function 
defined in ([6|) using this arbitrary extension of the Lagrangian function Cj\f. 



3.2.2 Dynamical equation 

The extrinsic dynamical equation for a constrained dynamical system is 

i{X)VL -dH £ ann(TW) , for X G X(W) tangent to W . (27) 

where a.nn{D) denotes the annihilator of a distribution D C TW. Observe that this equation is 
clearly equivalent to ([26]) . 



Then, following |29j we have 

Proposition 2 A solution to the equation (I27p exists only on the points of the submanifold 
Wc'^W defined by 

Wc={peW: {i(Y)dH){p) G ann(TpW) , VF G kerfl} . 

In natural coordinates, let ^l''^ G C°°(T'^(M x G)), 1 ^ a ^ n, be local functions defining the 
submanifold M ^T'^iM xG), that is, 

M={p£ T'=(M X G) : $"(p) = , 1< a ^ n| . 

In an abuse of notation, we also denote by <I>" the pull-back of the constraint functions to W. 
Then, the annihilator of TW is locally given by 

ann(TW) = (d^'^) . 

Therefore, the equation defining the submanifold Wc may be written locally as 

i{Y)dH = Xadf^"" , VyGkerSl, 
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where Xa, 1 ^ a ^ n are the Lagrange multiphers. Then, bearing in mind the local expression 
dD) of dH and dH of ker fi, the equations defining locally the submanifold Wc are 

Now, let us compute the local expression of equation ([27|) . If we assume that M is determined 
by the vanishing of the n functions $°, then equation ()27p may be rewritten as 

i{X)n - dH = Xad^'' , 

where Xa are Lagrange multipliers to be determined. Then, bearing in mind the local expression 
([8]) of dH and ^ of Q, taking a generic vector field locally given by ([9]) we obtain the following 
system of equations 



F/' = qf+i, (28) 

dq^ " dq^ ' dqf "' dqf 



^A - ^-4 - ^a-^-J , Ga - -W-A - -^"^TA - P\ ' (29) 



9Qk "^9fc 



Pa~' - TTa + ^'a^TA = ^ (30) 



ci = r, (31) 



^1 



a/: ^ a^'^ 

«^-i - ^^ + ^«^^ = ' (33) 

^"('?o9^,5,^,C'~') = 0. (34) 

Therefore, the vector field X solution to equation (|27|) is locally given by 



^^+1 QqA + ^k Q^A + ^QqA "^^ q^A ) q^O^ + [g^A "^^ q^A Pa ) Q^i^ 



+ TTT7 - Xa^:r-r -OLi 



Q^i " Q^i 'y Q^ 



H^\ 



dao 



Observe that equations (|30|) , (|33|) and (|M|) do not involve coefficient functions of the vector field 
X: they are pointwise algebraic relations, stating that the vector field X exists with support on 
a submanifold defined locally by these equations. Hence, we recover locally the result stated in 
Proposition [2j 

The coefficients F^ and ^^ of the vector field and the Lagrange multipliers A^ remain un- 
determined. Nevertheless, from Proposition [2] we know that the vector field X exists only at 
support on the submanifold Wc- Hence, we must require the vector field X to be tangent to 
Wc, that is, we must impose L(^)Clw — f°^ every constraint function ^ defining Wc- Then, 
taking into account that Wc is locally defined by equations ([30]) . (p3]) and ^^, the tangency 
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condition for X along Wc gives the following equations 



dC 



Pa 



ii+l 



k-1 



dqfdq^ 



e^-J'^' 



Xa 



dqfdq^ 

Q2^a 



+ Cl 



dC 



di 



^—2 - CHk-2 = Qi+l 



+^1 



\dgdq^ 
d^k~lQqA 

[dgdi 



Xa 



dgdq^ 

Q2^a 






d'^c 



i2fF.a 



d^^ 



Xa 



k-1 



Xa 



d^k-lQqA 
Q2^a 

dqfd^-^ 

Q2^a 



+ A« 



+ F^, 



dq^dq^ 
di'dq^ 



'dq^dq^ 

i2rF.a 



Xa 



Wdq} 



dq^ 



k-1 



d^c 



dqAg^k-l 



d^c 



k-latk-l 



dSJ'-^di 



Xa 



QgQ^k 1 



+ i 



i+1 



d'^c 



k-latk-l 



Q^k-IQ^. 



Ii+l 






+ Fi. 









+ e 



i+ 






+ei 






+ A, 



0. 



Q^iQ^k-l 



Xa 



Xa 



92 ^« 



dq^O^k-l 

Q2^a 



dc 



fc-2 



(35) 



If we denote by 0^^ the pullback of the presymplectic 2-form O to Wc, then we deduce the 
following theorem. 



Theorem 1 (Wc^Wc) ^^ c- symplectic manifold if and only if 



/ d^c 



2^a 



dqj^dq^ 



d^c 



d^k-lQqA ^« 



"dq^dq^ 

Q2^a 



k de-^dq^ 



V 



is nondegenerate along Wc- 



d^c 



dq^de-^ 



Q2(^a 

^"dq^de-^ 



i2fF>a 



Xa- 



a^$ 



Q^k-lQ^k-l ^Q^k-lQ^k-1 



Q^k 



k-1 



dq^ 

k-1 



d^ 



{Proof) The proof of this theorem is a straightforward computation using Theorem 4.1 in 
and Theorem 3.3 in 1121. 



Now, let 7: M ^ W be an integral curve of X locally given by (J17p . Then the condition 
X o 'J = 'j gives the following system of differential equations for the component functions of 7 



Pa 






dC 
dg 



dC 



a$« 



Xa r^ A 



-^a-K— I +ad*oao 



<lt 



1^ 



PA 



Oi+l 



dC 

9=9e 

dC 



^oTTT ~ Pa ' 



dqi 



i-l 



Xa 






--e, 

Oil, 



(36) 

(37) 

(38) 
(39) 



in addition to equations (j30|) . (j33j) and (|M|) . Now, using equations (j30|) in combination with 
(I37p we obtain the A:th order constrained Euler-Lagrange equations 






d' f dC 



1=0 



dt^ \dq: 



Xa 



A 



dq 



0. 



(40) 
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On the other hand, using equations (|33|) in combination with (|37p we obtain the kih order 
triviahzed constrained Euler-Lagrange equation 



d ^* \ v^/ ,.id' fdC ^ d<^^\ 



dt 

j=0 



7 



(41) 



Therefore, a dynamical trajectory 7 : M — > W of the system must satisfy the equations (P0|) and 
dH]), in addition to ^''{qf{t),qf{t),g{t),C(.t)) = 0. 

Finally, if both the extended Lagrangian function £ G C°°(T'^M xGx kg) and the constraint 
functions <I>'^ G C°°(T M xGx /eg) are left-invariant, then we can define the reduced Lagrangian 
function £ G C°°{T^M x kg) and the reduced constraint functions (f)"- G C°°(T'^M x kg) as 



and then equations (|1T]) become 



^^Oi:(-'>'^(f-f) 



a 
dt 

i=0 



= 0. 

7 

Note that equations (I40p remain the same, just replacing £ by £ and <I>° by 



4 Application to optimal control of underact uated mechanical 
systems 

In this section we study optimal control problems for underactuated mechanical systems (or 
superarticulated mechanical systems following the terminology in [1] ) . The presence of underac- 
tuated mechanical systems is ubiquitous in engineering applications as a result, for instance, of 
design choices motivated by the search of less cost devices or as a result of a failure regime in fully 
actuated mechanical systems. The underactuated systems include spacecraft, underwater vehi- 
cles, mobile robots, helicopters, wheeled vehicles, mobile robots, underactuated manipulators, 
etc. 

Let [/ C R^ be the control manifold where u{t) G C/ is the control parameter. We assume that 
all the control systems are controllable, that is, for any two points qq and qt in the configuration 
space Q, there exists an admissible control u{t) defined on some interval [0, T] C M such that 
the system with initial condition qq reaches the point qj- in time T (see [6] for details). 

Let us consider that the configuration space Q of the system is a trivial principal bundle, 
that is, Q = M X G, where M is an m-dimensional smooth manifold and G a finite dimensional 
Lie group. Let C G C°°(TM x g) be a left-trivialized Lagrangian function, where g is the Lie 
algebra of G. 

The Euler-Lagrange equations with controls are 

Jt[w)-W=''^^^^'^^ (l^A^m) 

d (dc\ ^, [dc\ ,, , ^ ^ 

where B"" = {(/x",r/")}, ii°'{q) G T*M, ry"(q) G g*, a = 1, . . . ,r, is a set of independent sections 
of the bundle vr: T*M x g* — )■ M, and Ua are admissible controls. 
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We complete B^ to a basis {B"^, S"} of r(7r), and let us consider its dual basis {Ba, Ba}, that 
is, a basis of r(T), where r: TM x g ^ M. Observe that r(T) = X(M) x C°°(M,g) (see [19] for 
details). This basis induces coordinates {q , q , ^"' , ^'^) on TM x g. 

If we denote Ba = {{Xa,Ea)} C T{t) and e„ = {X„,H„} C r(r), where Xa,X„ G X(M) 



3 
are locally given by Xa{q) = X^{q) 



dq 



A 



,XUq)=X^{q) ^ 



q 



dq' 



and '~a{q),'^a{q) e g, with 



<? 



g G M, then equations (j^zj) can be rewritten as 



d f dC\ dC\... }d(dC\ ^,dC\„.. ^ 



(43) 



Optimal control problem. The optimal control problem consists in finding a trajectory 
{q{t),q{t),^{t),u{t)) of the state variables and control inputs solving equation (|43p given initial 
and final conditions (q(0),g(0),^(0)) and {q{T),q{T),S,{T)), respectively, and minimizing the 
following functional 

Aiq,q,^,u)= I C{q{t)A{t),m.<t))dt, 
Jo 

where C : {TM x g) x [/ — ^ M is a cost function. 

Following [5] , to solve this optimal control problem is equivalent to solve the following second- 
order variational problem with second-order constraints 

min£(g^,g^,g^,e,e) 

subject to $°(g^, q^, q^,i\C) , a = 1, . . . , m 

where C, $" G C'^{T'^M x 2g) are given by 

f(g^,g^,^-^,e,r) = c(/,^^,r,F„(g^,g^,g^,e,e)) , 

where C is the cost function and 

..(/..^.^f .f ) ^ (I {§) - §) xf „) . (I (I) - (».^f )) ..(,) . 

The Lagrangian C is subjected to the second-order constraints: 

."(,^,^,-^r,a - {i {§) - ^) x^i.) . (I (f ) - (-jf )) H„(„. 

4.1 Optimal control of an underactuated vehicle 

Consider a rigid body moving in special Euclidean group of the plane SE{2) with a thruster 
to adjust its pose. The configuration of this system is determined by a tuple (x,?/, ^,7), where 
(x, y) is the position of the center of mass, 6 is the orientation of the blimp with respect to a 
fixed basis, and 7 the orientation of the thrust with respect to a body basis. Therefore, the 
configuration manifold is Q = SE{2) x S^ (see [6,J and references therein), where (x, y, 6) are the 
local coordinates of SE{2) and 7 is the local coordinate of §^. 
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The Lagrangian of this system is given by its kinetic energy 

C{x, y, e, 7, X, y, 6, 7) = -mix"^ + ij^) + -JiO^ + ^J2{0 + jf , 

and the input forces are 

F^ = cos(0 + 7) dx + sin(0 + 7) dy — psin7d6' ; F^ = d7, 

where the control forces that we consider are applied to a point on the body with distance p > 
from the center of mass (m is the mass of the rigid body), along the body x-axis. Note this 
system is an example of underactuated mechanical system when the configuration space is a 
trivial principal bundle. 

The system is invariant under the left multiplication of the Lie group G = SE(2): 

^■. SE{2)xSE{2)xS^ -^ SE{2)x8^ 

((a, 6, a), (x,y, 0,7)) 1 — > {xcosa — ysina + a,xsma + ycosa + b,9 + a,^). 

A basis of the Lie algebra se(2) ~ M.^ of SE{2) is given by 






ei = i u u , 62 = u u u , 63 



from we have that 

[61,62] =63, [61,63] = -62, [62,63] = 0. 

Thus, we can write down the structure constants as 

C31 = ^23 = — l,Ci3 = ^^32 = 1 ) 

and all others vanish. An element ^ € se(2) is of the form C = Ci 61 + C2 62 + ^3 63; therefore the 
reduced Lagrangian I: TS^ x se(2) — )• M is given by 

^(7, 7, e) = \m{ii + el) + ^^ei + ^267 + y f . 

Then the reduced Euler-Lagrange equations with controls are given by 

m£_i = ui cos 7 , 

mi2 + {Ji + J2)iii?. + J2iii - miii^i = nisin7, 

(Ji + J2)i^ + J27 - "1-6(6 + 6) = -uipsin7 , 

-^2(6+7) = U2. 

On the other hand, choosing the adapted basis {Ba-,Ba} the modified equations of motion ([15|) 
read in this case as 

m(cos7^i +sin7(^2 -66)) + (-/i + -^2)66sin7 + J2Ci7sin7 = ni , 
m(cos7(,^2 -66) -sin7,^i) +^i^3(Ji + J2)cos7 + J267COS7 = 0, 

— ^(6 + p66) + — (7 + P67) + "1 (6 -66 - ^-^ — ^) = 0, 

V V V p J 

hiiz + l) = U2. 

Now, we can study the optimal control problem that consists, as mentioned before, on finding 
a trajectory of state variables and control inputs satisfying the previous equations from given 
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initial and final conditions (7(0), 7(0), ^(0)), (7(T),7(T),,^(r)) respectively, and extremizing the 
cost functional 



/ (piuj + p2ul) dt , 
Jo 



'0 
where pi and p2 are non-zero constants. 

The related optimal control problem is equivalent to the second-order Lagrangian problem 
with second-order constraints defined as follows. Extremize 

A= [ £(^,^,7,7,7)di, 
Jo 

subject to second-order constraints given by the functions 

$1 = m(cos7(^2 - 6^3) - sin 7,^1) + S,iS,3{Ji + J2)cos7 -|- J2C17COS7, (44a) 

^' = ^^^^^{i3+pCi^3) + -{l+P^ii) + m(i2-^i^3-^^^^^^) ■ (44b) 

P P \ P J 

Here, Z: T^S^ x 2se(2) ^ E is defined by 

A7,7,7>?>0 = Pi \rn{cos-iii -h sin 7(^2 -66)) + {Ji + -^2)66 sin7 -h J267sin7J (45) 
+ P2J|(e3 + 7)^ 
which basically is the cost function C = piu\ + P2U2 in terms of the new variables. 
The submanifold M of T'^E>^ x SE{2) x 2se(2) is given by the constraints 

7 = -— U2-?i&-6 I J (6+P6C3) -Pi.il, 

6 = 7 66 H — 67 + 6 - 66 • 

tan 7 \ m m J 

We consider the submanifold W = TW x T*(TS^) x 2se(2)* with induced coordinates 

(7,7,5',6,6,6,6,6,??l,??2,Pl,P2,P3,Pl,P2,P3), 

and the restriction Cm of C given by 



^M = Pi 



^66 + — 67 + 6 -66 1 + («^i + -^2)66sin7-F J267sin7 



tan 7 \ m m 

+ sin 7(6 -66) 



+ P2J2 



6 - — 16 - 66 - 6 ) J — (6 +K16) -p67 



2 



Observe that we use the intrinsic formulation in the submanifold A4 because the constraints 
enable us to write the variables 7 and 6 in terms of the others, and thus it is easy to determine 
a subset of intrinsic coordinates. 

Then, we can write the equations of motion of the optimal control problem for this underac- 
tuated system. For simplicity, we consider the particular case Ji = J2 = 1 and m = p = 1 then 
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the equations of motion of the optimal control system are: 



e 



d 



ir 



dt 

m = 2pi 

Pl = 2/91 



7 = 

COS 7 
tan 7 

cos 7 



d 
di 



7 



7 



It 



7 > 



1,2,3. 



+ sin 7 ) • ^ 

2 



COS 7 



sm7 



1 



tan 7 
COS 7 



tan 7 cos^ 7 + tan^ 7 
+ sin7 ) • ^ - ^i(Ai cos 7 + A2 - 2Bp2) - ??i 



+ Aisin7^ 1 + 



tan 7 



^tan7 

^2 = (A2-2Sp2)(6+6), 

COS 7 



+ sin7 A] (S- A2)(6 + 7-6) - Ai 0037(7 + ^3) , 



P3 = 2^/91 



tan 7 



+ sin7 • ^ - Ai cos 76 - (6 - 6)(A2 + 2/92^3) 



Pi = 
where 



ad*^Pi , 



1,2,3. 



e = (6,6,6) ; ^ = 66 + 67 + 6 



^ = 6 + 66 + 6 - 66 - 66 + 67 



and the coadjoint operator is just the cross product, adtp = C x P using the identification of 
se(2) with R^. 

In all cases we additionally have the reconstruction equation 

m = <7(t)(6(i)ei + 6(i)e2 + 6(^)63) 
with boundary conditions (7(^0) ^ind g{tf), where g{t) = {x{t),y{t),6{t)). 
Finally, the regularity condition is given by the matrix 



A 



whose determinant is 

det A = 4pi/92 sin^ 7 + 4/9ip2 cos^ 7 + 8pip2 sin^ 7 cos^ 7 = 4/9ip2(sin^ 7 + cos^ 7)^ = 4pi/92 7^ . 

Therefore the algorithm stabilizes at the first constraint submanifold Wc- Moreover, there exists 
a unique solution of the dynamics, the vector field X € XiWc) which satisfies i(X)i7>Vc = di/yy^. 
In consequence, we have a unique control input which extremizes (minimizes) the objective 
function A. If we take the flow Ft : Wc -^ Wc of the solution vector field X then we have that 



/2p2 








2/92 





1\ 





2pi cos^ 7 


2pi sin 7 cos 7 





— sin 7 








2pi sin 7 cos 7 


2pi sin^ 7 





cos 7 


1 


2p2 








2/92 





2 





— sin 7 


cos 7 











V 1 





1 


2 





0/ 



5 Conclusions and further research 



We have defined, following an intrinsic point of view, the equations of motion for constrained 
variational higher-order Lagrangian problems on higher-order trivial principal bundles. As a 
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particular case, we obtain the higher-order Lagrange-Poincare equations (see |1H I24j). As an 
interesting application we deduce the equations of motion for optimal control of underactuated 
mechanical systems defined on principal bundles. These systems appear in numerous engineering 
and scientific fields. In this sense we study the optimal control of an underactuated vehicle. 

Moreover, in a future paper we will generalize the presented construction of higher-order 
Euler-Lagrange equations to the case of non-trivial principal bundles and in the context of Lie 
algebroids. This last approach will be interesting because we may derive the equations of motion 
for different cases as, for instance, higher-order Euler-Poincare equations, Lagrange-Poincare 
equations and the reduction by morphisms in a unified way (see [El [Ml l42]). 

The case of optimal control problems for mechanical systems with nonholonomic constraints 
will be also studied using some of the ideas exposed through the paper (see [HI [171 [35] for 
more details). Finally, we would like to point out that a slight modification of the techniques 
presented in this work would allow to approach the Clebsh-Pontryagin optimal control problem 
(see [261 [33]). 
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